/*
中位校准例子
*/
#ifdef U8X8_HAVE_HW_SPI
#include <SPI.h>
#endif
#ifdef U8X8_HAVE_HW_I2C
#include <Wire.h>
#endif
#include <SCServo.h>

int LEDpin = 2;
SMS_STS sm_st;

void setup()
{
	pinMode(LEDpin, OUTPUT);
	// Serial1.begin(115200); // sms舵机波特率115200
	Serial2.begin(1000000); // sts舵机波特率1000000
	sm_st.pSerial = &Serial2;
	delay(1000);
}

void loop()
{
	digitalWrite(LEDpin, LOW);
	sm_st.CalibrationOfs(1);
	digitalWrite(LEDpin, HIGH);
	while (1)
		;
}
